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@ METHODCONTROLUN6SBIVOMOTOR. 

@ A method of controlling a servomotor by controlling the 
speed and current of the servomotor in a digital manner. Cor- 
rection values (23. 27) are so applied that the integration gain 
(22) and the loop proportion gain (26) of the current control 
loop will increase depending upon the speed of the servo- 
motor. Since the current loop gain Increases depending upon 
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the speed of the servomotor, no oscillation takes place in the 
current loop when the servomotor runs at low speeds or is at 
halt Furthenmore, a decrease in tiie torque caused by the 
lowered cunrent loop gain during the high-speed operation 
can be prevented. 
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DESCRIPTION 

SERVO MOTOR CONTROLLING METHOD 

5 Technical Field 

The present Invention relates to a servo motor 
controlling method for controlling the rotational speed and 
the current of a servo motor under a digital control, and 
more particularly to a servo motor controlling method in 
10 which the gain of a current control loop is changed 
dependent upon the rotational speed of the servo motor. 

Background Art 

Due to an improvement of the performance of a 
15 microprocessor and the reduced cost thereof, a digital 
controlling method of a servo motor has been extensively 
employed as a servo motor controlling method. In Fig. 4, 
there is shown a block diagram illustrating a servo motor 
controlling method performed under the digital control, in 
20 which em operation unit 1 outputs a difference between a 
speed instruction VCMD and a speed feedback signal fb. An 
integrator 2 has a speed loop integration gain of kj^. An 
operation unit 3 outputs a current instruction value which 
is divided into three for three phases of a servo motor, and 
25 each of the divided values is fed to R, S and T phases - 
Since the arrangement of each of the phases is identical, 
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only the R phase is shown in the figure and the reminder is 
omitted therein. Designated by numeral 4 is a speed loop 
proportional gain. 

Denoted by reference numeral 10 is an R phase current 
5 controlling loop. An operation unit 11 outputs a difference 
between an R phase feedback current Ir and the current 
instruction. An integrator 12 has a current loop 
integration gain of k^. ^An operation unit 13 outputs a 
difference between the output of the integrator 12 and a 

10 current loop proportional gain kg designated by reference 
numeral 14. An operation unit 15 outputs a difference 
between a counter electromotive voltage E(S) of the servo 
motor and the output of the operation unit 13, in which the 
output of the operation unit 15 is the voltage output of a 

15 PWM control circuit. A first-order delay element 16 
includes a winding resistance R of the servo motor and an 
inductance L thereof. The output of the first-order delay 
element 16 is a current flowed in the servo motor. 

A torque constant is designated by reference numeral 

20 17 and its output is a torque. A motor 18 imposes an 
inertia Jm which is an integrator in terms of a numerical 
equation. The output of the motor 18 defines the rotational 
speed of the servo motor and gives a speed feedback signal 
fb. 

25 In such a servo motor controlling method performed under 

the digital control, however, a period of time required for 
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the software proceselng for the digital control is not 
negligible when the servo motor has reached a high speed 
rotational state. The delay of the processing time causes, 
in equivalence, to lower the current loop gain. Further, 
5 the electromotive force of the servo motor has become high 
and the current loop gain Is brought to a decreased status. 
For these reasons, the high speed rotations cannot be 
attained and the shortage of the' torque results. On the 
contrary, the constant rising of the current loop gain 
10 causes to occur oscillation of the current loop at the time 
when the motor is rotating at a low speed or is stopped. 

Disclost^re of the Invention 
An object of the invention is to resolve the 
15 aforementioned problems and to provide a servo motor 
controlling method in which the gain of a current control 
loop is changed dependent upon the rotational speed of the 
servo motor. 

According to the present invention, in order to solve 
20 the problems r there is provided a servo motor controlling 
method for controlling both a speed emd a current of a servo 
motor under a digital control, comprising: 

providing a current controlling loop in a speed loop; 

and 

25 controlling an integration gain and a loop proportional 

gain of said current controlling loop so as to be changed 
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depending upon the speed of said servo motor. 

Since the current loop gain is increased depending upon 
the speed of the servo motor, the oscillation in the current 
loop does not occur at the time of low speed drive and stop, 
and the shortage of torque due to the lowering of the 
current loop gain at the time of high speed drive can be 
prevented. 

Brief Description of the Drawings 
Fig. 1 is a block diagram showing one phase of a current 
control loop according to one embodiment of the present 
invention; 

Fig. 2 is a diagram showing one example of a function of 
(V) ; 

Fig. 3 is a flowchart illustrating a software processing 
according to one embodiment of the present invention; and 

Fig. 4 is a block diagram showing a conventional servo 
motor controlling system performed under a digital control. 

Best Mode for Carrying Out the Invention 
An embodiment of the present invention will be described 
with reference to the accompanying drawings. 

Fig. 1 is a block diagram showing a current controlling 
loop for one phase according to one embodiment of the 
invention. A speed loop is the same as the one shown in 
Fig. 3, and thus description thereof is omitted herein. In 
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Pig. 1, an operation unit 21 outputs a difference between 
the current Instruction Cmd of an R phase and a feedback 
current Ir. A current loop Integration gain 22 has a value 
of kl. A gain 23 has a value of 1 + a(v) and Is provided 
5 for correcting the current loop Integration gain. A 
detailed description of the gain 23 will be given later on. 
Designated by reference numeral 24 Is an integrator whose 
output Is a voltage. 

Designated by numeral 25 Is an operation unit; 26, a 

10 current loop proportional gain having a value of k2; 27^ a 
gain for correcting the current loop proportional gain 
having the same value as that of the gain 23 for correcting 
the current loop integration gain. The operation unit 25 
outputs a difference between the output of the integrator 24 

15 and the output of the current loop proportional gain 26. An 
operation unit 28 outputs a difference between the output of 
the operation unit 25 and the counter electromotive voltage 
E(S) of the servo motor. The output of the operation unit 
28 is applied as a PWM output to a PWM controlling circuit 

20 which controls a servo motor to determine a pulse width. 
The servo motor is designated by numeral 29, which is a 
first-order delay element in terms of a numerical equation 
in which R is a winding resistance of the servo motor and L 
is an inductance, the output therefrom being a current 

25 flowed in the servo motor. 

In this manner, by the correction of both the current 
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loop Integration gain kl and the current loop proportional 
gain k2 by another correcting gains "1 + a(v)", the 
resultant current loop integration gain and the current loop 
proportional gain can be changed depending upon the 
5 rotational speed of the servo motor. Hence, the shortage of 
torque at the time of high speed rotations and the increment 
of a speed deflection amount can be prevented. 

Next, an example of a function a(v) will be described. 
One example of the function a(v) is shown in Fig. 2 in which 
the axis of abscissa represents the rotational speed of the 
servo motor and the axis of ordinate represents the value of 
the function a(v) . When the speed is between 0 and va, the 
value of a{v) is zero, and when the speed is between va and 
vb, the value thereof increases linearly as the speed 
Increases. When the speed exceeds vb, the value thereof is 
clamped at a fixed value Om. 

-A 

Here, the value of at(m) is in the range of approximately 
from 2 to 2.5, the value of va is approximately 500 r.p.m. 
and the value of vb is approximately 3,000 r.p.m. It goes 
without saying that these values are given by way of an 
example and are variable depending upon the output of the 
servo motor and the rated number .of revolutions, etc. 

The control of the current control loop is implemented 
by a microprocessor. An outline of this software processing 
is shown in Fig. 3, in which the numerals following the 
character S represents step numbers. Various characters are 
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dafiMd to man mm followo. 

Kji Currtnt loop Inttoratlon o^ln (ftfttr oerrootlen) 
K^i Curront loop proportional o^ln (aftor oorreotlon) 
k^: Curront loop Integration gain (before oorraotlon) 
5 kg: Current loop proportional gain (before correction) 

Tpi^: Pttlae width from the PWM circuit 
[SI] Decision le made as to whether or not the current loop 
gains (current loop integration gain and the current loop 
proportional gain) are to be changed. Normally, the changes 
10 of these current loop gains are set by parameters. If the 
current loop gains are not changed, the procedure advances 
to S3 whereas if they are changed, the procedure advances to 
S2. 

[S2] Decision is made as to whether or not the rotational 
15 speed of the servo motor Is below the value that the 
function Oi(v) is to be clamped. If decision made in this 
step Indicates that the speed of the servo motor is below 
that value, the procedure advances to S4, whereas it is not 
below that value, the procedure advances to S5. 
20 [S3] Since the current loop gain is not changed, the current 
loop integration gain and the current loop proportional gain 
both before correction are used as they are- 
[S4] The current loop gain is corrected as described 
hereinbefore • 
25 = kj (1 + a(v)) 

Kg = kg (1 + a(v)) 
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[SS] The current loop gain is changed. However, since the 
rotational speed of the servo motor has reached the . clamping 
region in . the function Cl{v) , it is corrected by the clamp 
value "1 + flm". 

5 [S6] In accordance with the current loop gains as obtained 
in S3, S4 and S5, the pulse width of the PHM circuit is 

computed and output ted. 

In the above description, although the correction 
function of the. current loop gain is made to be linearly 
10 increasing as the speed of the servo motor increases, it is 
possible to employ other functions which varies along 
another curves depending upon the characteristics of the 
servo motor. 

As described, according to the present invention, the 
15 current loop gain is rendered increase depending upon the 
rotational speed of the servo motor so that shortage of 
torque emd increment of the speed deflection amount due to 
the lowering of the current loop gain at the time of high 
speed drive can be prevented without causing to occur the 
20 oscillation in the current loop at the time of low speed 
drive €uid stop. 
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CLAIMS 

1. A servo motor controlling method for controlllno 
both a speed end a current of a servo motor under a digital 
control, comprising: 

providing a current controlling loop In a speed loop; 

5 and 

controlling an Integration gain and a loop proportional 
gain of said current controlling loop so as to be changed 
depending upon the speed of said servo motor. 

2. A servo motor controlling method according to claim 
1, wherein said integration gain and said proportional gain 
are linearly Increased with respect to a rotational speed of 
said servo motor. 
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